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ABSTRACT 



This thesis presents the dynamic modeling and its application to the 
multi-link robot manipulators with joint flexibility. The twist angles of 
springs are utilized to model the joint flexibility. A direct dynamic model is 
derived by the Lagrangian method and the Newton-Euler algorithm is 
used for deriving the inverse dynamics. A motion controller is designed 
by the computed torque method based on the inverse dynamics. A 
recursive estimator is included in the control design to estimate the 
required feedback signals which are not directly measurable. 
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I. INTRODUCTION 



The problem of joint flexibility has been recognized in most industrial 
robot designs. Joint flexibility typically results from the torsional flexibility 
of the gear mechanism and drive shafts. The effect of joint flexibility is 
negligible for low-speed and light payload operations and the rigid-body 
controllers are able to successfully control the system. The rigid-body 
controllers refer to controllers that are designed based on a rigid-body 
dynamic model. As the speed and payload increase, the inertia forces 
and gravity forces increase such that the flexibility effect becomes 
significant. The flexibility may not be tolerated by the rigid-body controller 
and may cause system instability. The improvement of the dynamic 
behavior requires that the joint flexibility effects be incorporated into the 
controller design for industrial robots. A dynamic model of industrial 
robots with joint flexibility is therefore needed. 

The Lagrangian method was applied to rigid-body manipulators to 
obtain the direct dynamic model where the kinematics was described by a 
set of homogeneous transformation matrices [Ref. 1: pp. 158-172]. The 
recursive Newton-Euler method was used for solution of the inverse 
dynamic response to compute the required torques for rigid-body 
manipulators [Ref. 2: pp. 168-172]. Several nonlinear control techniques, 
namely feedback linearization, integral manifold and composite control 
[Ref. 3] were applied to design controllers for a single-link manipulator 
with joint elasticity. A position control was developed for a two-degree- 
of-freedom manipulator where the effects of drive-train compliance and 
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actuator dynamics were included [Ref. 4]. The control law was derived 
from the concepts of "computed torque" where the inverse dynamics 
were utilized to determine the required torques as the functions of 
position, velocity, acceleration, jerk and jerk rate errors. With the same 
control scheme, the computer simulation and dynamic analysis of a single- 
joint robot was conducted [Ref. 5]. The third joint of the PUMA 560 
robot was selected as an example and a comparison between the 
performances of rigid-body controller and flexible-body controller was 
performed. 

In this thesis, both the Lagrangian dynamics [Ref. 1] and the Newton- 
Euler algorithm [Ref. 2] will be applied to multi-link robot manipulators 
with joint flexibility. The former is used to derive the direct dynamics for 
the plant, computing the joint motion provided that the torque inputs are 
given. The latter is used to develop the inverse dynamics which returns 
the required torques assuming the joint motion is known. This thesis also 
uses the method of computed torque [Ref. 4] to design a control law for 
multi-link robot manipulators with joint flexibility. This control approach 
presents a method of decoupling the arm motion when drive-train 
compliance and actuator dynamics are considered. It is assumed that the 
angular positions and velocities of both links and motors are measurable 
from shaft encoders and tachometers. Since the second and third 
derivatives of link positions (i,e., accelerations and jerks) are required in 
the control design and not directly measurable, an estimator is designed in 
a recursive manner to obtain the second and third derivatives of link 
positions. 
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To present the frame work of this thesis, Figure 1 shows an error- 
driven feedback control system which includes the inverse dynamics 
(controller), direct dynamics (plant) and the estimator. In this figure, the 
system is designed to follow a reference input and the system error is 
generated by the difference between the desired reference input and the 
feedback. The Newton-Euler method is used to design the controller 
since its recursive formulation allows for the efficient computation of the 
inverse dynamics and therefore possibly for on-line control. The 
Lagrangian method derives the direct dynamics and models the plant for 
computer simulation because of its systematic nature which is convenient 
for programming. 

The objective of this thesis is to formulate the direct and inverse 
dynamics of multi-link robot manipulators with joint flexibility. In addition, 
a computed-torque control is designed to show an application of the 
inverse dynamics. Notations and preliminaries will be presented in 
Chapter II. The direct dynamics and the inverse dynamics will be 
discussed in Chapter III and Chapter IV, respectively. Finally, the 
controller and estimator design procedures will be developed in Chapter 
V. 
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Figure 1. Error-Driven Feedback Control System 



II. NOTATION AND PRELIMINARIES 



This section defines the notations used in the thesis and briefly 
discusses some of the basic fundamentals which will be used to develop 
the model. 

A. NOTATION AND PRELIMINARIES FOR THE DIRECT 
DYNAMICS 

a, : one of the four Hartenberg-Denavit parameters representing the 
distance between two adjacent frames i-\ and i in x direction. 

a i : one of the four Hartenberg-Denavit parameters representing the 
rotation angle about the x axis. 

d, : one of the four Hartenberg-Denavit parameters representing the 
distance between links in z direction. 

0, : one of the four Hartenberg-Denavit parameters representing the 
rotation angle of links about the z axis. 

q, : joint variable of link i. For prismatic joints i, q< is d t , for revolute 
joint i, q, is 0,. 

q mi : the rotation angle of rotor i about the z axis. 

G, : gear ratio, i.e., 

_ rotation angle of i - th motor shaft /0 . 

G = { l.\ ) 

rotation angle of i - th link 

A, : the Hartenberg-Denavit matrix for link i, i.e., 
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0 

sinq.sina 

-cosq^ina, 



( 2 . 2 ) 



1 0 0 



a.cosq, 

a.sinq, 



cosq, -sinq ( .cosa ( . 
sinq, cosq ( cosa. 
0 sin« ( . 



cost* 



A m . : homogeneous (4x4) coordinate transformation matrix of motor 

i, 



i.e., 



where 



'1 0 

0 cosq^. 
0 sinq 

x mi 

0 0 



0 O' 

-sinq ra - 0 

cosq 0 

x nu 

0 1 



q m =G,q, -<5, 



(2.3) 



(2.4) 



W, : homogeneous (4X4) coordinate transformation matrix from the i- 
th coordinate frame to the base coordinate frame. 

W? : homogeneous (4X4) coordinate transformation matrix from the 
/-th coordinate frame to the j - th coordinate frame, 
m. : mass of the t'-th link. 
m m . : mass of the i-th motor. 

r‘ : local position vector of the center of mass of link i decomposed in 
the body-fixed coordinate. 
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r„: absolute position vector of the center of mass of link i 
decomposed in the base coordinate. 
r mi : absolute position vector of the center of mass of motor i 
decomposed in the base coordinate, 
r’m, : local position vector of center of mass of motor i decomposed 

in the motor body- fixed coordinate. 

J : the pseudo inertia matrix of the z-th motor 

m, A 

J = fr‘ r ,T dm 

mz J mi nu 



0 

0 



0 



0 

^ miy_7 
2 

0 



0 



0 



0 

0 



mizz 

2 

0 



0 “ 
0 

0 

I 

mizz 
2 „ 



( 2 . 5 ) 



where I . is the moment of inertia of motor z in the local z axis. 

mizz 

Note: The elements in the first row and the first column are zero 
since the mass m of the motor i is considered to be included in 

mz 

the link z. 

J ( : the pseudo inertia matrix of the z-th link, where 
J = fr'r^dm 

i J i z 
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m 

i 

m.x 

mj, 



m,x 

-I + I + I 

ix x lyy 122 



ixy 



my 

t y t 

K 

^ixx " ^iyy + ^ ixx 



lyi 



m.z, 



^ ixx + ^iyy ’ ^ia 



( 2 . 6 ) 



where m.x., mj,., m ,.z,. are the first moments of link i, I Ux , I iyy , I u2 
are the moments of the inertia of link i in the principal axes and 
I Uy , 1^ ,I iyi are the products of inertia of link i. 

B. NOTATION AND PRELIMINARIES FOR INVERSE 
DYNAMICS 

<$, : G,q,-q m ,. 

ft), : absolute angular velocity of link i 
ft). : absolute angular acceleration of link i 
ft), : change rate of ft),, 
ft), : change rate of ft),. 

Q, : absolute angular velocity of link i in a matrix form. 

0) u : local relative angular velocity of link i decomposed in coordinate 
z-l,i.e., [0 0 q,] T 

d> u : local relative angular acceleration of link i decomposed in 
coordinate z'-l, i.e., [0 0 q,.] T 
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(b u : local relative angular jerk of link i decomposed in coordinate /-I , 
i.e..|0 0 q,f 

a ; : linear acceleration of link i 

; : absolute angular velocity of motor i decomposed in coordinate i- 
1. 

tb™ : change rate of co^. 

: linear acceleration of link / at the center of mass. 

F< : resultant force exerted on link i at the center of mass, 
f : force exerted on link i by link i - 1. 

N ; : resultant moment exerted on link i about the center of mass. 

n ( . : moment exerted on link i by link /-l. 

n m : moment exerted on motor i decomposed in coordinate i. 

T, : torque generated from the electromagnetic field of motor i in the 
local z axis. 

Rf : rotational transformation (3x3) matrix from the j-th coordinate 

frame to the z-th coordinate. 

K (> . : control gain. 

k ( . : spring stiffness, 
k : unit vector in the local z axis. 

I ( . : inertia tensor of link i, i.e., 




ixy 



ixy 



iyy 



iyz 



i 



iyz 




(2.7) 
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I : moments of inertia of motor i, i.e., 

mi 7 



0 

0 



0 

mi> 

0 



0 

0 

^ mizz _ 



( 2 . 8 ) 
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III. DIRECT DYNAMICS 



The Lagrangian dynamics approach is used to derive direct dynamics 
for the equation of motion of the plant in terms of the generalized 
coordinates. The Lagrangian dynamic equations are given as : 



where is the generalized coordinate, n is the number of degrees of 
freedom and denotes the generalized force. 

This thesis considers a plant of a six-link manipulator with revolute 
joints actuated by DC-motors. Each motor is connected through a 
transmission shaft (Figure 2) to a rigid link and a spring with a constant 
stiffness is modeled to be a major source of joint flexibility. The twist 
angle of the spring §. is defined as <5, = G t q ( -q mi . where G ( . is the gear 

ratio. Since additional degrees of freedom are introduced by the twisted 
spring , the generalized coordinates are defined as: 



The generalized force P y is obtained from the concept of virtual work. 
Since 





6 6 



5W = XT,5q ra =ST,(G,5 q,-<5<5,) 



i=l 
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FIGURE 2. Single-Link Manipulator With Joint Flexibility 
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therefore, T.G, is the generalized force corresponding to the generalized 
coordinate q ; , and — T is the generalized force corresponding to the 
generalized coordinate 8 r 

The total kinetic energy of the system consists of the individual kinetic 
energies of the links and motors and the total potential energy is 
composed of the strain energy due to joint elasticity and the potential 
energy due to gravity. The kinetic energy KE and the potential energy PE 
are derived as follows: Given a point specified by a local position vector 
r! (Figure 3), its position and velocity with respect to base coordinates are 
given as 



_-n 

II 

£ 


(3.2) 


and 




f = W r‘ 

t i i 


(3.3) 


The kinetic energy of link i is 




( KE )uo ^trjrr/dm 


(3.4) 



For six-link robot manipulators, the total kinetic energy becomes 



(KE) u; =X(KE) LKi 

1=1 

= X^ tr j»* i r i T dm (3.5) 

t=\ Z 

Substituting Equation (3.3) into Equation (3.5) gives 

(KE) u; =iitr[w(Jr;r; T dm)W,] (3.6) 

i= 1 Z 
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Figure 3. Position Vector of The Center of Mass of Link i 
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The integral in Equation (3.6) is known as the pseudo inertia matrix J, 
and was given in section II. Equation (3.6) thus becomes 



(KE)«=ifr[W,J,w] 

i=l Z 

Similarly, the kinetic energy of the motors is 

(KE)„=SitrJf„T mi T dm 

i=l Z 



where 



r = W .A r‘ 

mi i-l mi mi 



The time derivative of r is obtained as 

mi 

r = W .A r\ + W ,A r‘ 

mi i-l mi mi i-l mi mi 

and 



A m = 



TO 0 0‘ 

0 cosq mi -sinq mi 0 
0 sinq m( cosq mi 0 



0 0 0 1 
Substituting Equation (3.10) into Equation (3.8) gives 



(KE) m = tTr[(W„ ,A„,r: + W„,A.,rv) 

i=i z 

•(W. , A .r'. + W A .rOldm 

\ i—l mi mi i—l mi mi J 

= — tr[w .A ( [r‘ r‘ T dm)A T W r 

^ Y i—l mi yj mi mi J mi i— 1 



(3.7) 



(3.8) 

(3.9) 
(3.10) 



(3.11) 



(3.12) 



+W,. 1 A„.(Jr^dm)ALW i ! 1 

+W,-,A„.(Jr:.r£dm)ALW7. 1 ] 



Since 



tr 



W,-,A ra (J ] = tijw^A^J Cr^dmjA^W^ 



Equation (3.12) becomes 

(KE)„ =Sbr[w,. 1 A mi J m .ALW i I, 



i?\ 2 

-2W. 

i- 

+w. .A J A T w T ,l 

i- 1 mi mi nu i-1 J 



+2W. A J A T .W T , 

i-l mi mi mi i-l 



where 



J = fr^r^dm 

rru J mi mi 



and the total kinetic energy of the system can be found as 

(KE) = (KE) IX +(KE) m 

The potential energies of links and motors are obtained as 
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( pE )ut =- 5 >, r Jg 

l'=l 

= -imr: T W. T g 



1=1 



and 



(PE) = -tm r T g 

V / m jLmJ mi cmi“ 

i=l 

= -i I ".(w,AC) T g 

1=1 

= -Tm .r ,T .A T .W T ,g 

jLmi mi cmi mi i-lo 



i=l 



(3.13) 

(3.14) 

(3.15) 

(3.16) 

(3.17) 



(3.18) 



where 



g = 



0 1 

0 

0 

-9.8 



f_m_ \ 
Vsec 2 J 



The center of mass of link i is described by a local vector r c ‘ ; and the 
center of mass of motor i is described by a local vector rV. Their position 
transformations from local coordinate to base coordinate are defined as 
r c, = W,r: and r^. = respectively. 

The potential energy due to strain is 



(PE). = ilk, 5/ (3.19) 

Z i= i 

Therefore, the total potential energy of the system is obtained by 
combining Equations (3.17), (3.18) and (3.19) : 



(PE) = -t m,r;; W/g - Im.x^AlW.’.g + (3.20) 

i=l i=l Z i=l 



Since generalized coordinate q ( . is for large motion and generalized 
coordinate 6 i is for small motion, two sets of equation of motion will be 
obtained according to Equation (3.1). For the large motion, the general 
form of dynamic equation is described as 



itr(W,J,.W;) + tr(X.J 



■A T . W T ,)+ ftr(X J 

ny ny ,/ j- 1/ 1-4 \ J 



*=/+! 
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where 



-Z m , r a T Wj.g - - I m d r»Al.W 1 ' 1 .g = G .T. 



*=y 



»=y+l 



(3.21) 



X,=W,,,A„ 

x, = w ; .,a to+ w ; _,a^. 



ny 



(3.22) 

(3.23) 

(3.24) 



X, = W, .A . + 2W. jA .W, jA 

j j - 1 m; j - 1 ny j-l 

The dynamic equation for the small motion is described as 

-tr(X J .A\ W. T ,) + m .r yT A T . W. T .g + k.5. =-T (3.25) 

\ J ny mjj t-\ J ny ny nyj j- lfc> J J J v 7 

The second time derivative of the transformation matrix W ; can be 
derived as 



w, (3.26) 

k = 1 *=1 m=l 

I i 

where defined as the residual term that includes Coriolis 

k=\ m = 1 

and centripetal accelerations. A recursive form (see Appendix A) is used 
to compute the residual term to avoid tedious computation. The detailed 
procedure of direct dynamic equations is derived in Appendix B. 

For the special case of a rigid body plant, the stiffness of the spring 
approaches infinity. Therefore, the elastic displacement is equal to zero, 
and Equation (3.21) for the rigid body case reduces to : 

t tr( W,,J,W; ) ■ - 1 m ,rf W,’ g = T (3.27) 

l=j t=j 
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In this case, the Equation (3.25) presenting the small motion can be 
ignored directly. 
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IV. INVERSE DYNAMICS 



The inverse dynamics is to predict either the required driving force or 
torque for a mechanical system of which the motion (i.e., the joint 
positions, velocities, accelerations and jerks in this thesis) is known. The 
inverse dynamics of robot manipulators with joint flexibility is developed in 
this section by the Newton-Euler method. The controller and the 
estimator are designed based on the inverse dynamics for that is 
computationally efficient and has potential for on-line control. 

Figure 4(a) presents a free body diagram of the link i where f and rr 
are force and torque exerted by link i-l decomposed in coordinate i and 
f i+1 and n i+1 are force and torque exerted by link i + 1 decomposed in 
coordinate i + 1. This system of forces and moments is equivalent to that 
on Figure 4(b) where F and N, are the resultant force and torque acting 
on the center of mass. Therefore, the force and moment balance 
equations are obtained as 



By taking balance of moments in the local z direction on the free body 
diagram of the motor i (the bottom figure of Figure 5), the torque equation 
can be expressed as 



N =n -R ,+1 n -SI xf -Cl xF 

i i i i+l it it 

The Newton-Euler equations can then be written as 




(4.1) 

(4.2) 



F , = m , a ci 

N. = 1,0),. +£I(I,<o ) 



(4.3) 



(4.4) 
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(a) 



Figure 4(a). Free-Body Diagram of Link i 
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Figure 4(b). Resultant Force and Torque of Link/ 
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(4.5) 



T = (R! ,n ) k + (l . 0 ) +ft. .1 co ) k 

i V i-l i / \ mi mi i-l mj mi J 

where 



and 



co . = co,+< 

mi i-l 



0 

0 



(4.6) 



C 0 . = CO . +< 

mi i-l 



0 
0 

4mi , 



(4.7) 



From Equations (4.5), (4.6) and (4.7), the required torque T can be 
obtained if the kinematics of the manipulator is given. The recursive 
inverse dynamics of rigid-body systems has been available [Ref. 6] where 
the gravity has been incorporated into the kinematics. For flexible-joint 
systems, the motor variables are not identical to the link variables and q m , 
and q mi will be related to link variables in this research. 

Figure 5 shows three free-body diagrams, i.e., free-body diagram of 
link i, the i-th spring and motor i, which illustrate the relations among the 
moment m, the spring torque k.5,. and the torque T produced by the 
electromagnetic field of the motor. Since only the moments in local z axis 
are concerned, the moments acting on the both sides of the spring along z 
axis are equivalent in magnitude and opposite in directions. In other 
words, the component of the moment n ( . in the local z axis acting on link i, 
i.e., (R^n )-k, is equal to that acting on the spring in the local z axis. 
This relation can be given as 



23 




-R; +I n i+1 




M, ► — NN\|\|\ — ^ ( R !-: n ,) • k 



k,6 1 =k,(G i q i -q m; ) = (R;_ 1 n i )k 




kA 



Figure 5. Free-Body diagram of a link, a spring and a motor 
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M, =(R‘. 1 n i ) -k 



(4.8) 



or 



^ =^( R !-i n i)- k (4.9) 

As we defined 8 i in section II, q m can be described as 

= G ,q, “ ^ (4.10) 

By substituting Equation (4.9) into Equation (4.10), the angular position of 
motor/, i.e., q mi , can be expressed as a function of generalized coordinate 

q,: 

q*=c i q,-4(R!_,n j ).k 

I 

The above equation is equivalent to the following equation where the 
vectors are decomposed in the base coordinates. 

q m =G.q.-f(R;n.)-(Rrk) (4.14) 

I 

As referring to Equation (4.7), the first and second time derivatives of 
angular position of motor i are required to compute the torque T. By 
applying R' = R'Q ; , q mi and q m , can be obtained as 



<L = G,q, - ^[R;,(G.n. + ii, ) • (R? k) + (R'„n, ) ■ • (R;"Q,.,k)] (4.15) 
q„ = G,q, - J-{Ri(£l An, + H.n, + 204, + n, ) • (R-'k) 

+2r; (n,n, + h, ) • (R;-a,k) + ( r>, ) • [r;- 1 (n,.,k + n M n,.,k)]} 
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(4.16) 



where 



n = N j + R' +1 n i+1 + S1, xf. + Cl, x F (4.17) 

A. = o,N, + N, + r;* 1 (a M n M + n,., ) + a, (SI, x f, ) + SI, x f, 

+ O, (Cl, x F ) + Cl, x F — On (4.18) 

ii, =0,0,14, +20,N, + a,.N, + N, + R'* 1 (0,.,0,.,n,., 

+ 20, .,11,., + a,,,!!,., + n,„ j + 0,0, (si, X f, ) 

+ 2 A (SI, X f, ) + A (SI,. X f, ) + SI, x f, + A A (Cl, . x F, ) 

+ 20, (Cl, x F,) + 6, (Cl, x F f ) + Cl, x F, - 0,0, n, 

- 2Q.n. - Q.n,. (4.19) 



N.=I.fi).+Q.(l.fi).) (4.20) 

N. = l co. +Q I (o + Q .I ft) (4.21) 

N, = I,ft). + £il,ft),. + 2f2,I,ft), + 0,1,6), (4.22) 

co^Kr'fa^+co,,) (4.23) 

", = R r 1 (^,-."i, + "-> + "„) (4-24) 

", =R r 1 (^-. Q .-i^, + 2 &,-A.i +toi- a, +",-> 

+(«,,) -Q, ft),. (4.25) 

", = R r(« w Q w « M fl) w + 30,_ 1 0,- 1 ",, 

+ 2 0,_,0, + 20,_ 1 ft),_, + 30,_ 1 ft),, + 0,_A_i"u 



+6, + 30, _,&),, + 0,_,ft),, + (y,., + ft),,) 

-fan a +2n i a>. + n.a>.) (4.26) 



26 



The intermediate variables f ; , F ; , and their rates of change are described 
in Appendix C. 

Since 



0 ) 



U 



'O' 

< 0 > 

At, 



differentiating Equation (4.27) with respect to time gives 



(4.27) 



'O' 




O' 




O' 


< 0 


> ©u = < 


0 


” ©u = < 


0 > 


p: 

V 




At . 




q lv 



(4.28) 



Substituting Equations (4.27-28) into Equation (4.5) yields a fourth- 
order ordinary differential equation. The inverse dynamics can be simply 
describes as 

T=j; q ; v +f. (4.29) 

where f 4 . is a nonlinear function of arm position, velocity, acceleration and 
jerk, the term J* is a function of the moments of inertia of motors and links 
and spring constants. T is the required torque. 
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IV. CONTROLLER AND ESTIMATOR DESIGN 



The purpose of designing an controller for the manipulator is to drive 
the tracking error to zero asymptotically. In this section, a method of 
computed torque [Ref. 4] is utilized as a control scheme to determine the 
required torques. 

Define the error as 



£ = q,D-q, (5-i) 

where q iT) is the desired angular position of link i and q, is the measured 
angular position of link i. The error dynamics for the fourth-order system 
(Equation (4.29)) is described as: 

£ IV + K. 3 £ + K. 2 £ + K ( ,£ + K I0 £ = 0 (5.2) 

where the K's are constants representing the feedback gains. By 
substituting q IV in Equation (4.29) to the error Equation (5.2), the 

computed torque is then obtained as 

(5.3) 



% = JL,q" + f, 



ical 



where J‘ Ml is a calculated value of J* and f.__, is the calculated value of f... 



ical 



q^i is the "calculated jerk rate" given by 

q,1, = q£ + k i3 (q iD - 4 ) + k i2 (q iT) - 4 ) + K (q,B - 4 ) + - q, ) ( 5 - 4 ) 

where q ( »q,»q, an ^ q, are measured variables. J’^and f ical can be 
computed from Equation (4.29) based on the complete knowledge of the 
plant dynamics and availability of measurements. 

ITAE performance criteria [Ref. 7] for a fourth-order equation is used 
for the selection of the k values. The values are 
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(5.5) 



k„=2.1 a> a 
k (2 =3.4a>* 
k n = 2.7 col 
k i0 =1.0ft) n 4 

where co n is a selected value for the servo bandwidth. 

For a rigid-body case, the stiffnesses of all springs approach infinity, 
and the 5. approaches zero. Equation (5.3) is reduced to a second-order 
ordinary differential equation : 

(5-6) 

where 

q,d = q® + kn (q® -q.)+ Mq® - q, ) (5.7) 

and the values of the feedback gains according to the ITAE are : 

k n = \Aco n (5.9) 

k o=1.0 0) 2 n (5.10) 

The fourth-order system requires four measurements for each link to 
compute the driving torques. It was assumed that the angular positions 
and velocities of both links and motors are available from shaft encoders 
and tachometers. The second and third derivatives of link positions (i,e., 
accelerations and jerks) are not measurable. Equation (5.4) shows that 
the position, velocity, acceleration and jerk of link are required to compute 
the torques to drive the plant. An estimator in a recursive form is 
designed to estimate those variables that are not measurable (i., q, and q. 
) by using the measurements from those variables that are accessible (i.e., 
q,4>q mi and qj. 

By substituting Equation (4.20) into Equation (4.17), it becomes 

n, =!,<»,+ ) + Rr'n,., + SI, x f, + Cl, x F, (5.11) 
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then substituting Equation (4.24) into Equation (5.11) gives 
n, +<&,., +<) + Q,(I i ffl i ) + Rr l n, 

+ S1 xf +C1 xF 



(5.12) 



Substituting Equation (5.12) into Equation (4.8) yields 

M, ={R'. 1 [l,Rr'(£i„,<B u +<u,., + <) + £>, (I,©,) 

+Rf'n,.,+Sl l xf,+CI,xF]}-k (5.13) 

Equation (5.13) is rearranged as 

(r^i.r;- 1 ®,., ) ■ k = m. - {r;_, [i.r;- (a..,©,, + ©,., ) + n , (i,©, ) 

-R"n,„+Sl l .xf j +CI,xF,]}-k (5.14) 

Recall Equation (4.28) where 



©« = « 



0 
0 ► 



therefore Equation (5.14) can be rewritten as 

-R;“n M +Sl i x(;.+CI J .xF j ]}-k) (5 15) 

where (R'^LR'" 1 )^ represents the element of the third column and the 
third row in matrix (R‘_,I.R‘ _I ) . 

Again, Differentiating Equation (4.8) gives 

M, =(R;.,n.n, +R;. 1 n i )k + (R;_,n,)-£2 w k (5.16) 

Similarly, referring to Equations (4.17), (4.18), (4.21), (4.25)and (4.28), 
Equation (5.16) becomes 



Mi 



(R‘-,i,Rr' 
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q, = 7 — : — (k.6, -{R‘ ,fl n. + R‘ .\2Q.l d> + £2 Q Leo 

^ (R 1 I R l_1 ) v 1 1 L *-l i i i-l L tit i i i i 

\**-l i*i / 33 

+a,i 1 (o i - n,N, + i,r;-‘ (n, a»» + o H # w + 20 w <& u 
+^,_i<u u +<B w ) + £ij(SI, xf,) + Sl, xf. +0,(01, xF,) 

+CI .xFfl-k)- , 1 (R‘. ,n )fl k (4.48) 



where 



<5, =Gq.-q mi 

For the rigid-body controller case, as <5, approaches zero, the 
number of degree of freedom of link i reduces to one. The system 
governing equation then becomes a second-order ordinary differential 
equation. Since the required feedbacks q, and q ( . are measurable , no 
estimation is needed. 



VI. SUMMARY 



A. CONCLUSIONS 

A direct dynamic model and an inverse dynamic model have been 
developed for multi-link robot manipulators with joint flexibility. Since an 
additional degree of freedom was considered for joint flexibility, two sets 
of system dynamic equations were derived by the Lagrangian method for 
direct dynamics which returns the robot joint motions according to input 
torques. The first equation described the large motions of links while the 
second described the small motions of twist angles of joint springs. These 
two equations are expressed in a form suited for the sequential integration 
method [Ref. 8]. Moreover, the Lagrangian method is systematic and 
easy to program. 

The Newton-Euler method was used to develop the inverse dynamics 
which returns the required torques assuming the robot joint motions are 
known. The Newton-Euler method provides efficient computation and 
has potential for the on-line control purpose. The inverse dynamics for 
multi-link robot manipulators was derived by decoupling the link dynamics 
and motor dynamics. A fourth-order system equation of link variables 
was obtained and a fourth-order error dynamics was designed for 
controller. This control was finally achieved by the design of a recursive 
estimator which estimates the second and third time derivatives of link 
positions. The advantage of the estimator is to eliminate the differentiation 
process that would cause noise problems. 
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B. RECOMMENDATIONS 



The recommendations are listed as follows: 

1. Continue to perform computer simulation for multi-link robot 
manipulators with joint flexibility. 

2. Evaluate the performance of flexible-body controller. 

3. Implement the flexible-body controller for on-line control. 



33 



APPENDIX A. DERIVATION OF THE RESIDUAL TERM 



The residual acceleration mentioned in this thesis includes all the 
nonlinear terms caused by the Coriolis acceleration and centripetal 
acceleration due to link motion. The residual accelerations can be 
computed through a recursive form and computational efficiency can be 
therefore improved since the detailed computational procedure of each 
nonlinear term is skipped. 

Recall Equation (3.26): 



The recursive form W n is derived as follows. The derivation begins 
with the recursive relation of homogeneous transformation matrix W., 



i i < 




(A.l) 



The residual acceleration is defined as 



i j 




(A. 2) 



W and W 

i i 



W = W ,A 

i i-l i 



(A. 3) 



Therefore, 




(A. 4) 
(A. 5) 



since 




(A. 6) 
(A. 7) 
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where 



'0 0 0 0 

0 0-10 
0 10 0 

0 0 0 0 



(A. 8) 



is called the operative matrix for revolute joints. For prismatic joints, it 
becomes 



'0 0 0 O' 

0 0 0 0 
Q = 

0 0 0 0 
1 0 0 0 

The recursive form of W. is rewritten as 



(A. 9) 



W. = W._,A. + W._,A. + W. 1 QA i q, + W^QA.q, + W^QA.-q, 



(A. 10) 



If i=l, 

W, =W 0 A 1 +W 0 A 1 +W 0 QA 1 q 1 +W 0 QA 1 q 1 +W 0 QA 1 q I (A.ll) 

where 



then 



'10 0 0 
0 10 0 
0 0 10 
0 0 0 1 



(A. 12) 
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W 0 =W 0 =0 (A. 13) 

and (A.ll) becomes 

w, = W t QA,q, + W ( ,QA,q 1 

= W 0 QQA,q,q,+W 0 QA 1 q 1 (A. 14) 

According to Equation (A.l), Equation (A. 14) can be expressed as 

W, = W rl + W 0 QA,q, (A. 15) 

where 

W rl = W 0 QQA,q 1 q I (A. 16) 



If i=2, 

W 2 = W, A 2 + W, A 2 + W,QA 2 q 2 + W,QA 2 q 2 + W,QA 2 q 2 

= W, A, + W,QA 2 q 2 + W,QA 2 q 2 + W,QQA 2 q 2 q 2 + W,QA 2 q, 
= W,A 2 +2W,QA 2 q, +W,QQA 2 q 2 q 2 + W,QA 2 q 2 (A.17) 
Substituting equation (A. 15) into (A.17) yields 



W 2 = ( W rl + W 0 QA,q 1 ) A 2 + 2 W,QA 2 q 2 + W,QQA 2 q 2 q 2 + W,QA 2 q 2 



= (W rl A 2 + 2W,QA 2 q 2 + W,QQA 2 q 2 q 2 ) + WoQAjA.q, 
+W,QA 2 q 2 (AJ8) 

where 

W, 2 =W I1 A 2 +2W,QA 2 q 2 + W 1 QQA 2 q 2 q 2 (A.19) 

Similarly, the rest of the residual terms can be found in a recursive 
manner as z'=3,4,5,6 and so on. Therefore, a general form of residual 
terms can be obtained as 

w„ = W„,A, + 2W_ 1 QA,q, + W,.,QQA,q,q, (A.20) 

where /=1 ,2 6 
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APPENDIX B. DERIVATION OF DIRECT DYNAMICS 



A direct dynamics is modeled by using the Lagrangian method. The 
Lagrangian equation is given as 



where £ are the generalized coordinates, n is the number of degrees of 
freedom and P y denotes the generalized forces. 

The generalized coordinates are defined as 



where the generalized coordinate q, for large motion represents the 

angular position of link i and the generalized coordinate 8 i for small 

motion represents the angular displacement between q, (i.e., link position 

variable) and motor position variable q mi . 

The generalized force P^ obtained from the concept of virtual work is 

defined as 



where TG, is the generalized force acting on the generalized coordinate 
q,, and -T is the generalized force acting on the generalized coordinate 



Two dynamic equations, named the dynamic equations of large motion 
and the dynamic equations of small motion according to generalized 





6 6 



5W = XT,5q„.=lT,(G,5q i -55 1 ) 



1=1 



1=1 



37 



coordinates, are derived separately in general forms for the sequential 
integration method in simulation. 

A. THE DYNAMIC EQUATION OF LARGE MOTION 

The dynamic equation of large motion is derived from Lagrangian 
equation with generalized coordinate of link. Performing the differentiation 
of Equation (3.7) with respect to q ^obtains 



<?(KE) IX _1A 


d\V. T ■ 

, ‘J.W. +W.J. 




T “ 


<?q, 


Da 11 11 


[■h J 





by introducing the notation 



d W d W 
= = W . 

<?q, 



for i > j 



Equation (B.l) can be rewritten as 



<?( KE )uc = -Y tr(w. J W T +WJ.W T .) 
dq, 2~ 1 j) 



where 



and (B.3) becomes 



tr(W„J,W;) = tr(W,.J.W,: < ) 



^ k = Itr(W,,J i W;) 

d q y 



(B.2) 

(B.3) 

(B.4) 

(B.5) 
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by substituting Equation (B.4) into Equation (B.3). 

Differentiate Equation (B.5) with respect to time gives 



d_ 
d t 



<?(KE) 



LK 






= ttr(W, v JX+W i ,J,W, T ) 



(B.6) 



*«/ 



since 






(B.7) 



k = 1 



Equation (B.6) becomes 
<9(KE) 



d_ 

dt 



LK 



<?q ; 



= 2> 



(B.8) 



IW w q, J,W, +W,.,J,W, 

«'=/' LV*=i / 

The second term of the Lagrange equation due to link kinetic energy 
is obtained by differentiating Equation (3.7) with respect to q^: 



where 



<?(KE) IJ; _ 1 ‘ 


dw. . x . 

, ‘ J.W +WJ. 




T " 


2 h 


3q, 







= 5 > 



(dVI 






. -J,w. 



(B.9) 



tr 



d w . , ^ 

-r— w.w, 


t-H 
• 4 — » 

II 


<— i 


pwV" 


(■H J 






1 

■-> 

c r 



and 



W,=SW u q, 



* = 1 



(B.10) 
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for i > j 



(B .11) 



d W 



Equation (B.9) then becomes 



i = W 1/ =XW,,,q, 
*=1 



^(KE)^ 



= Str 



iw,.,,q, J,WT 



(B.12) 



d Qj i=J LV*=i 

Similarly, performing the differentiation of Equation (3.14) with respect 
to q j obtains 



<9(KE) ‘ 1 

— — = X~tr<! 



d $j 



~2 

+W ( ._,A mi .J mI . 

d W 



P) W r) A 

— A « l J»- A LW j T 1 + w. , — — — j_.a t .w. 1 



r<?A v 






m» mi i-l 






d % 



wY+w^ajkaL 



y 



<? w,., Y 



V 



+2 



+W. .A .J . 

i-l m; mz 



d A 

“-A J A T W T + W A T W T 

mi itu mi i -1 i-l ~ — — 






mi mi i- 



YaY t 



d( \j 



W ,+W A J A 

i-l mi mi mi 



J 



d W Y 

d *i 



<?W . . d A . 

-t^-a^j^aLw;, + w w — ^j.aL.w.I, 

<?q, 



+W A J . 

i—l mi mi 






W T . +W .A J A t 



. . d W T 



i—l mi mi mi 



d % 



(B.13) 



Since A mi are not functions of q y , and i> j + 1, thus 



*A„ . 



= 0 
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J 



= 0 



By introducing the notation 



<? w ,„ 

d % 



w MJ 



(B.14) 



Equation (B.13) becomes 



1 |«r{(W,-, J A m J m ALw:,+W w A„,J 1 ,ALW7_ 1J ) 



+2 



W , .A .J ,A T W T , + W. .A J . 

i—l, y mi mi mi i-l i-l mi mi 






d A 

w,_, J„,A T „W.:, +W.,A ; J . 



J 

(3k Y 

V ) 



W 



i-l 



w ;, 



(B. 15) 



as 



and 



tr(W. A J A t .W. t . ) = tr(\V. A .J .aVW* ) (B.16) 

\ i—l , j mi mi mi i-l J \ i-l mi mi mi i — l,y } 



tr 



d A . 

dqj 



= tr 



W^J,, 



d A .) 
j 



W 



i-l 



(B.17) 



one can finally obtain 



41 



<?(KE) 



JT^ = Itr[W,. 1 „A n .J„,A:,W,I 1 +W^ w A - J - A:<] 
a q j i=y + 1 



o 

+ 2 > 



1=1 






<?A m , 



w +w . 

»-i 1-1 






• T T 

J A W , 

mi mi i-l 

(B.18) 



Introducing the notations as follows: 



d A 

A . = — — — q = A 

~ ' * ny m y,y 



imj 



d q 

q„= G /),- 5 ; 



where i=j 



i=l 



(5A - 'l 


r 


J 





A G , if i = j 

ny,y y ’ ^ 

0, if i * j 



(B.19) 

(B.20) 

(B.21) 



substituting Equation (B.21) into Equation (B.18), Equation (B.18) 
becomes 

pp = i tr[W,. 1 . ) A m ,J m A:w: i +W..,,A m J„ Al W,:, ] 

+tr[W,. 1 A w ;„ / G / A: / . / W ( >W i ,G,A TO .,J TO A;w; i ](B.22) 
Differentiating Equation (B.22) with respect to time obtains 



d_ 
d t 



<?(KE) m 

_ 



= tr(\V ,A ,J.G f A’ y W T +W. .AJ.GA'w’ 

\ y-1 my ny y rcyj y-1 my ny y ny,y j_ x 

+W. ,A J G A T W T + W A J G.A t . .W t 

y-1 my ny y ny.y y-1 my my y my,y ; _j 

+W. ,G A .J A T .w T , +w. ,g A j ,A t .w t , 

y-1 y ny.y my my y-1 y-1 y ny.y my ny y-1 

+W. ,G A . .J A T .W T , +W .A J G A\ \V t ) 

y-1 y ny.y my my y-1 y-1 my ny y ny.y y 
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where 



+ Itr(W.,,A„J m A:W,;, + W„ w A m J ra A:W.:, 

*=7+1 

+w hj a - j - a:w; i + w, 1 ,A nu .j ml A:.w ( : 1 
+w H ,A ro j m A>: 1 + w,A m j m A:w;, 
+W hj A - J - a:w; i + ^ 1 ,A m ,J>:,W: i ) (B.23) 



trfw. ,A J G.A t ..W t ) = tr(w. ,A J .G.A' .wM 

\ y-1 my my y my,y H J \ y-1 my my y ny.y > . I y 

Equation (B.23) then becomes 



d_ 
d t 



<?(KE) r 



= tr(W .A J G.A t ..W t +2W. ,A J .G.A\.W t 

+W wj A - I - A>;, + W^A^AlW,:, 

+W / .,G,A„ jJ J„ i AVw;. 1 + W / .,G / A, / .,J„,.A;w; i 

+w,. 1 .,a„,j„,a:w,: 1 ) 

+ Y tr(w. . A .J .A t .W t ,+W ...A .J ,A t .W. t , 

ij y x-l,y nu mx mi x -1 x-l,y mx mx mi x -1 

*'=7+1 

+2 W i . lty A mi J mi .A: i W i .: i + W._, ; A mi J mi . A 1; W/j 
+W. , A .J .A T .W. T , + W. . .A .J .A t .W. t , 

i-l, y mi mi mx x -1 x — 1 ,y mx mx mx i — 1 

+W ...A .J A T W T ,) (B.24) 

i-l, y mi mi mx x -1 / v 

The second term of Equation (3.1) due to motor kinetic energy is 



£ SBL = ± i, r j 

dq } 7^2 ' 



/9 W d A 

— A_J_..ALW T , + W,_, — — — J.n.ATW^, 



‘H 



mi mx mi i-l 






+W ,A J 

x-1 mi mi 



(d a_,Y 4 

j 






W. T , +W A J A T 

x-1 i—l mx mx mx 



3 W - V 
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+2 



<9W 



i-1 






A m J m ,A‘W‘ + W w 



<9 A. 






-T A T W T 

J m ’’i-1 



<9 A 

+w i _ 1 A nu .j nu .— + W^A^.AL 



3 W.., 1 


T “ 


<H J 





+ 



P) w /9 A 

— —A j A T w T .+w. . — -j .A T .w. T . 

mi mi mi i-l i-l mi mi i-1 






+W ) ._ 1 A mi J m) . 



O A. 






y r 

w/, + w,. .A^.A* 

) 



j W M V 



(9 W. . <9 W . 

As the terms — and — exist only when i> j + 1 the 

<9 q, <9 q, 



<9 A <9 A 

—and — exist only when i > j, and 

<9q, <9q y 



tr 



( d W , T • T 1 






3 W, 'l 


T “ 


A J A T .W T , 


= tr 


W ,A J .A T . 




■H J 


i-1 mi mi mi 


^q- J 





tr 



^ . d A . . ^ 

W. .A W 

i-1 ~ — — 









mi mi i-1 



= tr 



J 



W A J 

i-1 mi mi 



<9 A mi 
<9q, 



V ^ 
9 ) 



tr 



f <9 W , . . T T ^ 






( <9 W ( ._, " 


T “ 


,_1 A .J A .W . 


= tr 


w. .A J .A T . 




1 ■H J 


i-1 mi mi mi 


-H J 





(B.25) 

terms 
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tr 



W 



*A„ 



-J .A T .W T , 



= tr 



W^.J. 



*A„ 

dq, 



V \ 

w/_, 



Equation (B.25) can be rewritten as 



<? (KE)„ £ 1 . 

dq ] iTjix 2 ' 



<9 W. . x • x <9 W,. , 

2—: — — A J A T .W T , +2-^-^A .J .A T W T . 

— — - — - ~ m/ mi mi i-l 



d % 



mi mi mi i-l 



d % 



V 



+2W ,A m ,J m A 



<9 W 



i-l 






1 

+-tr 

2 



2W. A T .W T , +2W 

y-l 2) ^ "V my y-l y- 



l 2 ^ A J A T W T 

^ ^ -) ^mi mi mi i-l 

. <9 A 






— j A T .W T , 

1 _ my my y— 1 






+2W ,A J . 

y— 1 my ny 



'dk V 






d A 

W T , +2W. , — — — J A T W T 



y-i 



y-i 



-H 



my my y— 1 



(B.26) 



Introducing the notation 



Equation (B.26) becomes 



<9 A 

— = A 






my.y 



(B.27) 



. ^ E ) m = y tr(w , A J .A t .W t , + W. , A J ,A T .W T 1 

\ i — l,y mi mi rru t— 1 i— 1 ,y mi mi iru i — 1 



*'=y + i 



+W,,A„J,A:.W i :, / + W^^AIX, ) 
+tr(W i .,G,A rt ,J w A;w;, + W / .,G / A. w J n> A:,W’ , 

+ w,.-,a^g,a;,w;, + w^.a^avw;, ) <b. 28 ) 
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The last term of Equation (3.1) is obtained by differentiating Equation 
(3.20) 



d (PE) 

dq } 



= -Z m .r/ T W„ T y g - A^W/_,g - A^.W.^-g (B.29) 



«=/ 



i-/+l 



Introducing the notations 

X,=W,„A„ (B.30) 

X =W ,A +W. ,A . (B.31) 

X = W .A . +2W. A W .A . (B.32) 

y y-1 my y-1 ny y-1 ny 

and combining Equations (B.8), (B.12), (B.24), (B.28) and (B.29) 
according to Equation (3.1) gives the final general form of dynamic 
equation of large motion, i.e., 



y tr(w J.W T ) + tr(X J A T ..W T 1 )+ Ytr(X J .aVw. 1 ,.) 

\ t,j i i J \ j ny my,y y-1 / \ y ny my i-l,y j 

<=y /=y+l 



-Zm/^g-m^A’ X->8“ S m » r ™- A L W w.y8 = G y T. 






;=y+l 



(B.33) 



B. THE DYNAMIC EQUATION OF SMALL MOTION 

The dynamic equation of small motion is derived from Lagrangian 
equation with generalized coordinate of deflection. The first term in 
Equation(3.1) can be written as 



d (d (KE) ' 
dl{ 3 8, , 



d ( 3 (KE)^ ' 

dl l 3 j 



d p(KE)J 

di{ 35, J 



where 



d f <?(KE),A Q 

dl l 3 3 1 J 

therefore, performing the differentiation of Equation (3.14) with respect to 
8j gives 



d (KE), 



A 1 

= S^r tr i 



9 8 132 



7) vv /9A 

—A J .A T .W T . +W. . r— J A t .W t . 

mi mi mi i-1 i-1 o mi mi i-l 



9 8 



‘ -1 9 8, 



+W._ 1 A mi J nu . 






\ T 






W T , +W A .J ,A t . 



9 W 



i-l 






9 8 



J 



+2 



9 W ; , • n- t <9 A . 

t^-A J .A t .W t ,+W. . A W T 

(9 ^ . nil mi mi i-l i-l ^ ^ mi mi i-1 



+W i ._ 1 A mi .J nu . 



( 9 A . Y _ . . T r 9 W . 

W,!, + W. I A m J nu .AL 






9 8 



) 



9 W . . . _ <9 A 

“'-A J A t .W t , +W. . 



9 8 



+W. .A J 

i-l mi r 



9 8 



-J A t .W t . 

mi mi i-l 






9 A 



V 






Wi+W^J^AL 



<9 W 



V 



i-l 



^ y 



(B.34) 



(9 W . <9 W . (9 A . • , 

As the terms 4—, and are not functions of <5. thus 

9 8 9 8 . <9 



J > 



<? W,, 

<9 5. 



= 0 
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■?W,- 

8 8 . 



= 0 



£A,- 

dS t 



= 0 



and 



tr 





•< 

05 


T 




W .A J 


mi 


W T , 


= tr 

V 


i—l mi mi 


IhJ 





W 



d A m 

~dJ. 



•J ,A T W.\ 

mi mi i-l 



where 




exists only when i > j , Equation (B.34) then becomes 



9 (KE). 1 

3 8 2 

J 



2W h A^ 



d A 



V 



my 



8 8 



W,./ + 2W.., 






y y 



8 8 



j A T W T 

™ j - 1 



i J 



introducing the notation 



(B.35) 



Equation (B.35) becomes 



8 A . 

2 L = _A 

8 8 



(B.36) 



d (KE), 

8 8 . 



= tr(-W A J A . .W , T -W ,A J .A T W , T )(B.37) 

V y-1 my my ny.y y-1 y-1 ny,y my ny y-1 / 



Differentiating Equation (B.37) with respect to time obtains 
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d 
d t 



^ d (KE) m ^ 

3*, j 



= tr(-W. A J .A t ..W t , -W ,A J A t ..W t , 

V j - 1 ny my my,y y- 1 y-1 my ny my ,y y-1 



-W ,A .J .A T ..W T -W. ,A J .A t ..W t , 

y-1 my ny my.y y-1 y-1 ny my ny.y y-1 



- w;, - w w a;.w;, 

- W^A^A^W;, - W,_, A„.,J w .A;w;, ) (B.38) 

The second term of Equation (3.1) is obtained as 



°' (KE) " =I t r 



dd. 



d A . T T . d A . • T T 

2W : , -r— r SL J_.A_..W.. . +2W ; . -r-^j A W 



y'-i ^ ^ “ ny* ~m/ ' ' y-i 



y'-i 






my my y-1 



+2W.. 1 A m .J 



ny 



(d AJ 


T 


d A • • T T 


ny 


w. . + 2W. . 


mj J A W , 




y-1 y-1 


Z) C my my y-1 



and as 



(B.39) 



d A d A . 

^ _ ny_ 

dS ; mU ~ d 8. 



(B.40) 



d , \ . d A . 

-(-A ) = -A .. = =*- 

dt \ m i-i / «v-y 



= tr[-W. A ..J .A t .W t , -W .A ..J .A t .W t , 

L y-1 my.y ny my y-1 y-1 my.y ny my y-1 



(B.41) 



Equation (B.39) can be rewritten as 
<? (KE), 

-W,.,A„.J„.A^, T w;, - W / .,A.,,J^A>; 1 ] (B.42) 

The last term of Equation (3.1) is obtained by differentiating Equation 
(3.20) with respect to <5.: 
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(B.43) 



Since 



3 (PE) 

3 8 . 






d 
d t 



^c?(KE) N 



'LK 






3 8 



= 0 



d_ (KE)^ 

3 8 



j J 



= 0 



j (PE)^ 

3 8 . 



= 0 



combining Equations (B.38), (B.42) and (B.43) according to Equation 
(3.1) gives the final general form of dynamic equation of small motion, i,e., 



where 



,) + m x' T A T ..W T 1 g + k.<5 =-T 

■1 / ny ny.y y- 1® j j j 


(B.44) 


n 

JS 

I 

> 

5. 


(B.45) 


= W y . 1 A nV+ W. 1 A nv 


(B.46) 


= W ,A . +2W .A W A . 

y-1 ny y- 1 my y-1 my 


(B.47) 
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APPENDIX C. NEWTON-EULER RECURSIVE 
FORMULATION 



Referring back to the definition of the absolute angualr velocity of link 
i for revolute joint: 

=R;' 1 (C.1) 

By premultiplying rotation transformation matrices, the angular velocity of 
link i is transformed as 

R> i = Ri- -MO,,) (C.2) 

Differentiating Equation (C.2) w.r.t. time according to Rj> = R‘ 0 £T yields 

r;o.o), +R‘t», =r;- , q._ 1 + «,.) + R , ; , (ft) i ..i +«,,) (c.3) 

since 

Q i co i - 0 

equation (C.3) becomes 

Ku, = Ro '^i-i (^,-1 + &>,,,) + R' 0 1 (^i-i + ) (C.4) 

multiplying Equation (C.4) by R)' in both sides gives 

= K' + < ) ( c - 5 ) 

Where 



Ro R ; =r 0 



i-1 



and R°Rl = 



1 0 O' 
0 1 0 
0 0 1 



(C.6) 



Similarly, differentiating Equation (C.6) once and twice w.r.t time gives 
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til + ^-i) + 6 i - 1 fi>, ll - +2Q i _ 1 d),.+cd i _ l +fl) w ]-Q.fl) i 

(C.7) 

®, =R!' I (^i-.© w + + 2Q w O, , +3Q._ 1 Q ( - 1 < 

+ + 3Q. i _ l cd li + 

+ 6),., + 0), j - (n.Q.d). + 2£Xa> ( ) (C.8) 

The linear acceleration of link i expressed in terms of base coordinate 
is given as 

Ria, =R;(R'-'a w + £1,Q,SI, + 6, SI, ) (C.9) 

differentiating Equation (C.9) w.r.t. time yields 

R'cA a . + Ro a i - K +a ,-i ) + R’o(^AA +2Q;Q. + £2A +Q,)Sl i 

(C.10) 

By multiplying R n in both sides, Equation (C.10) can be rewritten in a 
recursive form of derivative of the linear acceleration, i.e., 

a ; = Rj. 1 ( 3. i _ 1 + ) + ^£2^ + 2d.Cl i + Cl Cl + £T jSf — £Ta ; (C. 11) 

Similarly, differentiating Equation (C. 11) gives the second derivative of 
linear acceleration, i.e., 

a, = Rp^Q^a^ + 2Q._,a 1 _ 1 +Q._,a l ._ 1 + &,_,) 

+ (£2. + 30 2 0. + Q.Q.Q + 2Q Q Q + 30 2 + 3£2X2 +0X2 +O )S1 

\ i ii iii itt i ii it t j i 

-(Q?a.+Q.a l .+2Q i a i ) (C.12) 

The derivatives of force and torque can be obtained by following the 
same way. The results are as follows: 

f, =F +R‘ +1 f <+1 (C. 1 3) 
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f=0,F +E+R:*‘(0,. 1 f,. 1 +f. 1 )-0f 


(C.14) 


OOF, + 20, F, +0,F, +P, +R‘*'(0„ 1 0,. 1 f,. l + 20,.,f,., 


+ + f + i ) 


-(ft ft .f + 2ft.f. +Q.f.) 

y i ii ii i ! J 


(C.15) 


F ; = m,a d 


(C.16) 


F = m,a a 


(C.17) 


F) = m.a. 


(C.18) 


a d = a, + £2,C1, + ft,ft,Cl; 


(C.19) 


a c , = a, + ft,ci, + ft, ft, Cl, + ft, ft, A 


(C.20) 


a. = a, +ft Cl +ftft Cl. +2ft ft Cl +ft ft Cl 

Cl 1 11 III III III 


(C.21) 


N. = I. d) +ft.I.ft) 

i ii iii 


(C.22) 


N; = i, ft), + £2, i, ft); + 12, i, ft), 


(C.23) 


N, = 1,(1), + 6, .1, CD, +20,1,©, +0,1,6, 


(C.24) 


n , = N, +R’* 1 n„ l +S1, x f, +CI, x F, 


(C.25) 



Ii, = O.N, + N, + R;*‘ (0,.,n,., + n,„ ) + 0,(S1, x f.) + SI, x f, + O, (Cl, x F ) 

+CI, x F -0,n, (C.26) 

ii, = 0,0, N, + 20, N, + O.N. + N, + R:*'(0 M Q w n,„ + 20,.,n,„ 

+0.„ n,., + ii,., ) + 0,0, (SI, x f, ) + 20, (SI, x f, ) + O, (SI, x f ) 

+S1, x f. + ft .ft, (Cl, xF) + 2ft, (Cl ,. x F ) + ft, (Cl, x F,. ) + Cl, x F. 

-ft ft n -2ft ri -ft.n. 

iii ii ii 



(C.27) 
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